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real*4 ep(5),x (5) . y (5) . z (5) . xs (5) , ys (5) . zs (5) 
real*4 al (200). bl (200). cl (201) 



Hj=1 234556 
fO=0. 05 

dlh=15.0/fO ! cm 
na=16 
writeC*. 10) 

formate Enter the location of x.y.z (cm) 
read(*. *. end=90) xp. yp, zp 



(3) 



'$> (2) 



cat I marray (xp. yp,zp, na, cl) 
do i=2,na+1 

verr=ran(t i j) 

a I ( M) =c I ( i ) * (1 . 0+ (ver r-0. 5) *0. 001 ) -c I (1) 
end do 

writeC*,*) ' AUm)\ (al<i>. i=1,na) 
wr ite(*,*) 

call mcycle (na, dlh. al) (5) 

do i=1,5 

ep(i)=1.0e20 
end do 

do ix=~30, 30 

xp=float(ix)*lQ. 0 
do ty=>-30 ? 30 

yp=float(iy)*10.0 
do iz=-30.30 



! noise 0. 1 % 



(4) 



zp=float(iz)*10.0 



(6) 



(7) 



ca ] I marr ay (xp. yp. zp. na.cl) 
do fs?2. na+1 

M<M)=cl(i)-cl(1)-aKM) (8) 
end do 

oail itcycie(na, dlh, bl) (9) 
er=0. 0 
do i=1.na 

er=er*bl (i)**2 (10) 
and do 
do i=1.5 

if (er . It. ep(i)) then 
if (i .n«. 5) than 
do j=5. i+1.-1 
ep(j)=ep(j-1) 
x(j)=xU-1) 
y(i)=y(j-1) 

2(j)=Z(j-r1) 
and do 
end if 

ep<i)=er 
X (i)=xp 

y(i)=yp 

z(i)=zp 
go to 30 



(11) 
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end if 
end do 
cont i nue 
end do 
end do 
end do 

do i=1.5 

xs(i)=x(i) 

ys(i)=y(i 

zs{i)=z(i 
end do 

write(*,*) ' RMS error (cm) x y z (12) 

do i=1„5 

write<*,*) sqrt(ep(i)/float(na)),x(i).y(i).z(i) 
end do 

do m=1,5 In'tt 
xO=xs(m) 
yD=ysO&) 

20=zs0n) 
do ix=-15, 15 

xp=f I oat (ix)+xQ 
do iy=-15. 15 

yp=f loat(iy)+yO 
do iz=-15, IS 

zp=f Ioat(iz)+z0 

call marrayCxp.yp.zp.na.ct) 
do i=2, na+1 

bl(M)=cl(i)-cl (l)-al(i-D 
end do 

call fncycle(na,dlh,bl) 
er=0. 0 
do i=1 . na 

er=er+bl (i)**2 
end do 

do <=1,5 

if (er . It. ep(O) then 
if (i ,ne, 5) then 
do j=5. 1+1. -1 

8p(j)=Bp(j-1) 

x(j)=x(j-1) 
y(j)=y(j-l) 
z(j)=z(]-D 
end do 
end if 

ep(i)=er 
x(i)=xp 
y(i)«yp 
z(i)=zp 
go to 35 
end if 
end do 
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continue 
end do 
end do 
end do 

end do 
^^r i t e C -1 ^ ^) 

writer!*) sqrt(ep(1)/float(na)).x(1),y(1) > 2(1) (14) 

wr ite(*. *) 
go to 20 

stop 
end 

subroutine marray (xp. yp, zp, na, cl) 
real*4 cl (1) 

c( (1)=sqrt(xp*xp*yp*yp+(zp*50. 0)**2) 
do i=2 t na+1 

ixx=i/3 

iyy=i-ixx*3 

xm=f I oat ( j xx-1 ) *50. 0-1 0, 0 
yw=f I oat ( i yy-1 ) *50, 0+1 0, 0 
c I < i ) =sqrt ( <xp-xm) **2+ (yp-ym) **2+zp*zp) 
end do 

return 
end 

subroutine mcycie(na, dth, at) 

real*4 el (1) 

do i=1,na 
continue 

if (al(i) .gt> dih) then 

al(i)=al(i)-dlh 

if (al(i) . le. dih) go to 46 

go to 40 
end if 
continue 

if (al(i) . It -dih) then 
al(i)=al(i)+dih 
if (al<i) .ge. -d!h) go to 46 
go to 45 

end if 

continue 
end do 

return 
end 
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Enter the I 
z3L(cm) 
-69. 24731 
0. 9732714 
-51.46763 

RMS error 
0. 6834297 
0. 8562734 
1. 116775 
1. 163736 
1. 216863 



ocation of x. y, z (cm) : 152,-203,56 
67.67562 -38.21133 -1.487458 39.09471 



(era) 



-27. 88023 
-102. 0754 
-3. 269386 



1 50. 0000 
1 50. 0000 
150.0000 
160.0000 
160.0000 



8. 4395386E-02 152.0000 



1 6. 30007 
-54. 30361 



-200. 0000 
-190. 0000 
-200. 0000 
-230. 0000 
-220. 0000 

-203. 0000 



-91. 74537 
-5. 570741 



60. 00000 
50. 00000 
50. 00000 
70. 00000 
60. 00000 

56. 00000 



-46. 11990 
-98. 28325 



Enter the location of x, y, z (cm) : 22,123.-89 
^L(cm) 5.506481 57.46710 16.50204 -17.27929 

55.74849 14.06553 -20.41722 66.89948 28.19106 

-2.332703 89.04320 55.22502 29.83902 119.4193 

90.37129 69.39222 



RMS error 
1 . 445567 
1 . 754374 

1. 951296 

2. 345274 
2. 709345 



(cm) 



20. 00000 
20. 00000 
20.00000 
20.00000 
20.00000 



6. 2024966E-02 22. 00000 



130.0000 
130.0000 
120.0000 
120.0000 
140.0000 

123.0000 



-90. 00000 
-100. 0000 
-80. 00000 
-90. 00000 
-100. 0000 

-89. 00000 



Enter the location of x. y, z (cm) : 60,161,5 

.jL(cm) -23.45399 32.54938 -13.85323 -57.41031 

21.66080 -27.96993 -77.36571 22.85288 -26.38201 

-74.96463 36.05470 -9.367880 -51.50449 59.00156 

18.86572 -15.62937 



RMS error 
1.358104 
1.400364 
1.561480 
1.779230 
1. 850774 



(cm) 



60. 00000 
60. 00000 
60. 00000 
60.00000 
60. 000O0 



160.0000 
160.0000 
170.0000 
170.0000 
150.0000 



4. 4650473E-02 60. 00000 161. 0000 

Enter the location of x.y, z (cm) : 



10. 0O0OO 
0. OOOOOOOE+00 
0. 000O00OE+0O 

10. 00000 

10. 0000O 

5. O0000O 
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